/*********************检测29005************
  i2cData[0] = 7;
  i2cData[1] = 0x00;
  i2cData[2] = 0x00;
  i2cData[3] = 0x00;
  while (i2cWrite(0x19, i2cData, 4, false));
  while (i2cWrite(0x6B, 0x01, true));
  while (i2cRead(0x75, i2cData, 1));
********/
bool print_message(void *)
{
  if (a5 == 1)//  打印reg
  {
    Serial.println("******************dump reg ***********************");
    mn_sensor_I2C_Read(0x00, i2cData, 8);
    Serial.print("reg0x00=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x01=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x02=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x03=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x04=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x05=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x06=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x07=");
    Serial.println(i2cData[7], HEX);
    mn_sensor_I2C_Read(0x10, i2cData, 8);
    Serial.print("reg0x10=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x11=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x12=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x13=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x14=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x15=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x16=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x17=");
    Serial.println(i2cData[7], HEX);
    mn_sensor_I2C_Read(0x20, i2cData, 8);
    Serial.print("reg0x20=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x21=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x22=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x23=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x24=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x25=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x26=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x27=");
    Serial.println(i2cData[7], HEX);
    mn_sensor_I2C_Read(0x30, i2cData, 8);
    Serial.print("reg0x30=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x31=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x32=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x33=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x34=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x35=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x36=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x37=");
    Serial.println(i2cData[7], HEX);
    Serial.print("reg0x38=");
    Serial.println(i2cData[8], HEX);
    Serial.print("reg0x39=");
    Serial.println(i2cData[9], HEX);
    mn_sensor_I2C_Read(0x40, i2cData, 8);
    Serial.print("reg0x40=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x41=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x42=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x43=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x44=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x45=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x46=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x47=");
    Serial.println(i2cData[7], HEX);
    Serial.print("reg0x48=");
    Serial.println(i2cData[8], HEX);
    Serial.print("reg0x49=");
    Serial.println(i2cData[9], HEX);
    mn_sensor_I2C_Read(0x4A, i2cData, 8);
    Serial.print("reg0x4A=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x4B=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x4C=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x4D=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x4E=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x4F=");
    Serial.println(i2cData[5], HEX);
    mn_sensor_I2C_Read(0x50, i2cData, 8);
    Serial.print("reg0x50=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x51=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x52=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x53=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x54=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x55=");
    Serial.println(i2cData[5], HEX);
    Serial.print("reg0x56=");
    Serial.println(i2cData[6], HEX);
    Serial.print("reg0x57=");
    Serial.println(i2cData[7], HEX);
    Serial.print("reg0x58=");
    Serial.println(i2cData[8], HEX);
    Serial.print("reg0x59=");
    Serial.println(i2cData[9], HEX);
    mn_sensor_I2C_Read(0x5A, i2cData, 8);
    Serial.print("reg0x5A=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x5B=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x5C=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x5D=");
    Serial.println(i2cData[3], HEX);
    Serial.print("reg0x5E=");
    Serial.println(i2cData[4], HEX);
    Serial.print("reg0x5F=");
    Serial.println(i2cData[5], HEX);
    mn_sensor_I2C_Read(0x60, i2cData, 4);
    Serial.print("reg0x60=");
    Serial.println(i2cData[0], HEX);
    Serial.print("reg0x61=");
    Serial.println(i2cData[1], HEX);
    Serial.print("reg0x62=");
    Serial.println(i2cData[2], HEX);
    Serial.print("reg0x63=");
    Serial.println(i2cData[3], HEX);
    mn_sensor_I2C_Read(0x69, i2cData, 1);
    Serial.print("reg0x69=");
    Serial.println(i2cData[0], HEX);
    Serial.println("******************dump reg done***********************");
  }
  return true;

}
